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REPORT SUMMARY 


This is a final report presenting the research results obtained from the research grant 
entitled development of Advanced Control Schemes for Telerobot Manipulators,” funded 
by the Goddard Space Flight Center (NASA) under a research grant with Grant Number 
NAG 5-1124, for the period between February 15, 1989 to Dec 31, 1990 . 

To study space applications of telerobotics, Goddard Space Flight Center (NASA) has 
recently built a testbed composed mainly of a pair of redundant slave arms having 7 degrees 
of freedom and a master hand controller system . This final report presents the mathemat- 
ical developments required for the computer simulation study and motion control of the 
slave arms . The first part of the report presents the slave arm forward kinematic transfor- 
mation which is derived using the D-H notation and is then reduced to its most simplified 
form suitable for real-time control applications. The vector cross product method is then 
applied to obtain the slave arm Jacobian matrix. Using the developed forward kinematic 
transformation and quaternion representation of the slave arm end-effector orientation, 
computer simulation is conducted to evaluate the efficiency of the Jacobian in converting 
joint velocities into Cartesian velocities and to investigate the accuracy of the Jacobian 
pseudo-inverse for various sampling times. In addition, the equivalence between Cartesian 
velocities and quaternion is also verified using computer simulation. In the second part 
of the report , we deal with the motion control of the slave arm. Three control schemes, 
the joint-space adaptive control scheme, the Cartesian adaptive control scheme and the 
hybrid position/ force control scheme are proposed for controlling the motion of the slave 
arm end-effector. Development of the Cartesian adaptive control scheme is presented and 
some preliminary results of the remaining proposed control schemes are presented and 
discussed. 



1 Introduction 


Kinematically redundant 1 manipulators classified as manipulators whose number of de- 
grees of freedom (DOF) is greater than that of task space coordinates has been subject of 
considerable research in the last several years [1, 8] because of their many advantages as 
compared to non-redundant manipulators. In a non-redundant manipulator, there exists 
a finite set of joint variables and associated manipulator configurations such as elbow 
up or elbow down for a given position and orientation of the manipulator end-effector. 
Thus the manipulator joint motion is uniquely determined for a prescribed end-effector 
trajectory and a given pose. Consequently, non-redundant manipulators are limited in 
their ability to track an arbitrary end-effector path because of singularities, joint limits, 
and obstacles, which might occur along the corresponding joint trajectories. On the other 
hand, in redundant manipulators, a prescribed end-effector trajectory corresponds to an 
infinite number of joint motions due the redundant DOF’s which enable the manipula- 
tor to avoid singularities and obstacles, to keep the joint variables within their physical 
limitations, to minimize kinetic energy and to provide greater dexterity. Recognizing the 
above advantages, robot designers have adopted redundant manipulators for future space 
robots which will replace or assist astronauts in performing space operations. A Flight 
Telerobotic Servicer (FTS) which is responsible for numerous tasks on the future NASA 
space station, such as assembly, inspection, servicing, and maintenance is currently under 
intensive study and development at the Goddard Space Flight Center (GSFC). An inte- 
gral part of the research facilities at GSFC is a dual-arm telerobot system which consists 
mainly of a pair of 6-DOF mini-master controllers and a pair of 7-DOF redundant slave 
arms. The telerobot system serves as a testbed for investigating a variety of research 
issues of telerobotic operations in space, including zero-g operation, teleoperated and au- 
tonomous control, dual-arm manipulators, advanced control of redundant manipulators, 
hierarchical control etc. [9]. 

This report presents some mathematical developments which will be used in the com- 
puter simulation study and real-time control of the slave arm motion. In particular, we 
will focus on the manipulator forward kinematics, differential motion analysis and propose 
three control schemes for the slave arms. The organization of this report is described as 
follows. Next section will give an overview of the GSFC telerobot system and briefly de- 
scribe the structure of the slave arm. Then the forward kinematic transformation for the 
manipulator is derived in its most simplified form using the Denavit-Hartenberg notation. 
After that, we obtain the manipulator Jacobian using the vector cross product method and 
then discuss the pseudo-inverse of the Jacobian. Computer simulation is then conducted 
to evaluate the efficiency of the Jacobian in converting joint velocities into Cartesian ve- 
locities, to investigate the accuracy of the Jacobian pseudo-inverse for various sampling 
times and to verify the equivalence between Cartesian velocities and quaternion. Finally 
three control schemes, the joint-space adaptive control scheme, the Cartesian adaptive 
control scheme and the hybrid position/force control scheme are proposed for controlling 

lr The term “redundant” is often used instead of “kinematically redundant”. 
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the motion of the slave arm end-effector. Development of the Cartesian adaptive con- 
trol scheme is presented and some preliminary results of the remaining proposed control 
schemes are presented and discussed. 

2 The GSFC Telerobot Testbed 

The GSFC Telerobot Testbed as shown in Figure 1 is composed mainly of a master arm 
system and a slave arm system and interfacing/control devices. The master arm system, 
the Kraft Mini Master (KMM), manufactured by Kraft Telerobotics, Inc., has a left arm 
and a right arm, each of which consists of a KMC 9100F-MC Force Feedback Master 
Controller and a KMC 9100-S Master Control Electronics System. Each master arm has 
6 DOF’s arranged to provide two assemblies, a shoulder assembly to provide the primary 
motions of azimuth, shoulder elevation and elbow, and a wrist assembly to provide roll, 
pitch and yaw. Position feedback is obtained through potentiometers mounted on the six 
joints. The slave arm system, manufactured by Robotics Research Corporation (RRC) 
consists of a pair of K-1607 slave arms, each of which is an anthropomorphic redundan- 
t manipulator having 7 DOF’s with human-arm-like tool-handling dexterity. The arm 
mechanism is a series of joint drive modules, each of which contains an electric servomo- 
tor, harmonic drive gear reducer, joint position and torque transducer, joint travel limits 
and associated structural elements. GSFC engineers have studied the RRC controllers and 
some hardware modifications were performed to accommodate future implementation of 
advanced control schemes such as adaptive and intelligent control, and other advanced 
features such as high-speed parallel processing. 

We now use Figure 2 to explain the operations of the telerobot system. As the figure 
shows, force sensors and joint position/ velocity sensors mounted on the slave arms provide 
the RRC slave arm system with feedback data of joint forces and joint positions/velocities, 
respectively. Force reflection at the KMM system can be achieved by applying an appro- 
priate coordinate transformation on the slave arm joint forces. A task can be performed 
either in a teleoperated mode or autonomous mode. In the teleoperated mode, the human 
operator residing in an operator control station remotely controls the motion of the slave 
arms via the KMM arms using familiar hand and arm movements while observing the 
slave arm motion and the task space from a window or a TV monitor. The force/torque 
applied by the human operator on the KMM handles produces 6 joint forces/positions in 
the master arm system, which then are converted to 7 corresponding joint forces/positions 
in the RRC slave arm system via an appropriate coordinate transformation. The 7 joint 
variables will then serve as the reference inputs to the control system of the RRC arm. 
Based on the errors between the reference inputs and actual joint variables provided by 
feedback data, and governed by a control scheme, the controller sends appropriate sig- 
nals to the slave arm actuators so that the end-effector tracks the desired motion with 
minimum tracking errors and simultaneously applies a desired contact force on the task 
environment. In addition, the human operator can feel the forces exerted on the end- 
effector by means of a force reflecting system which produces back-driving forces in the 
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master arm joint actuators based on the feedback data of the slave arm joint forces. When 
a task is to be performed in the autonomous mode, reference inputs to the slave arm con- 
trol system can be generated by a path planner. The reference inputs can be expressed in 
joint space or in Cartesian space. Following the convention in [31], 8 coordinate frames 
are assigned to the manipulator as illustrated in Figure 3 showing the manipulator in its 
home configuration with all joint angles being zero. Each ith frame {i} is characterized by 
its coordinate axes Xi, y,, z, and its origin 0, for i = 0,1,2,. . . ,7. The Denavit-Hartenberg 
parameters for the assigned coordinate frames are listed in Table 1 given below: 
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Table 1: D-H parameters of the RRC K-1607 manipulator. 


3 The Forward Kinematic Transformation 


This section considers the forward kinematic transformation for the above slave arm, 
which can be used in a Cartesian-space control scheme to transform the 7 joint angles 0, 
for i=l,2,. . . ,7 of the slave arm into the corresponding position and orientation, referred 
here to as configuration of the manipulator end-effector frame, Frame {7}, with respect 
to the base frame, Frame {0}. The configuration of the ith frame with respect to the 
(i-l)th frame is represented by the following homogeneous transformation matrix: 
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for i=l,2,. ..,7 where ] -1 R and ‘ _1 p represent the orientation and position of the ith 
frame expressed in the (i-l)th frame, respectively. The transformation °T consisting of 
the orientation matrix °R and the position vector expresses the configuration of Frame 
{7} with respect to Frame {0} and is computed by 
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Carrying out the matrix multiplications in (3) and performing intensive trigonometric 
simplifications we obtain 
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(11) 


jl — ^6^2 " S 6 <72 
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and we have used the compact notations, c t = cos0, and S{ = sin It is also noted 
that in (5)-(ll), a;_i and d, for i— 1,2,. . . ,7 are manipulator parameters listed in Table 1. 
Since matrix multiplications are avoided in (5)-(ll), the computation time required for 
the above forward kinematic transformation is greatly reduced. Consequently, the derived 
forward kinematic equations are highly suitable for real-time control implementation. 


4 Differential Motion Analysis 

This section is devoted to the analysis of the slave arm differential motion. In the following, 
we first compute the manipulator Jacobian using the vector cross product method and 
then discuss its inverse computation using the method of Moore-Penrose pseudo- inverse. 
After that, we review the quaternion representation of orientation which will be used in 
the computer simulation study. 


4.1 The Manipulator Jacobian 

To be compatible with the coordinate frame assignments according to the convention 
given in [31], the vector cross product method [11] is modified and applied to derive the 
manipulator Jacobian. According to [11] the manipulator Jacobian is obtained by 


J = 


J] J2 J3 J4 J5 *^6 J7 


( 12 ) 


where 
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and bi, defined as the unit vector pointing along the axis of motion of Joint i expressed 
in Frame { 0 }, is given by 
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(14) 


with 
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and p,, defined as the vector pointing from the origin of the ith-frame to the origin of 
Frame {7}, expressed in Frame {0}, is obtained from 
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and x indicates the vector cross product. A Fortran program was written to compute the 
manipulator Jacobian J whose first three columns are presented below: 
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4.2 The Jacobian Inverse 


The Cartesian velocity vector x(f) are related to joint angle velocity vector q(t) by the 
Jacobian J as 

x(t) = Jq(0- ( 20 ) 

The inverse solution to (20) which minimizes the weighted quadratic form q r W -1 q, is 
given by [14] 

q(<) = jU(0 + (I 7 -jU)z (21) 

where J , the Weighted Pseudo- Inverse of the Jacobian J is given by 

jjy = WJ T [JWJ T ]- 1 (22) 

W, the Weighting Matrix is a symmetric matrix, z denotes an arbitrary joint velocity 
vector and the second term of (21) belongs to the null space of J. Vector z can be 
selected for optimization purposes. When W = I and z = 0, then (22) reduces to the 
well-known Moore-Penrose Pseudo-Inverse of the Jacobian given by 


\-i 


jt = J r (JJ T )- 

which provides the minimum norm least-squares solution. 


(23) 


4.3 Quaternion Representation 

Quaternion has gained more popularity than Roll-Pitch- Yaw Angles in representing ma- 
nipulator orientation because Roll-Pitch-Yaw Angles suffer from singularities and com- 
putational complexities [13]. The Quaternion consisting of a scalar rj and a vector s = 
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On the other hand, an orientation matrix R can be computed from its quaternion by 
the inverse operator defined by 


so that 
where 


Now considering two orientation matrices °R and ®R which represent the orientation 
of Frame {1} and {2} with respect to Frame {0}, respectively, we can write 
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In (30), since jR is postmultiplied to °R, jR represents a rotation of Frame {1} about 
Frame {1} to move Frame {1} to Frame {2}. jR can also be interpreted as the orientation 
of Frame {2} with respect to Frame {1}. However if the rotation is performed about 
Frame {0}, then we should write 

°R = *R°R (31) 

where jR represents the rotation of Frame {1} about Frame {0} to bring Frame {1} to 
Frame {2} and can be computed from (31) as 

lp Op 0 t> - 1 Op Op T (99) 

2 IV — 2 -tV- j IV — 2 -LV j J 

Suppose (7 i,Si) and (72, s 2 ) are the quaternions of °R and “R, respectively. Then the 
quaternion of jR can be expressed in terms of those of “R and °R as follows: 

67 = 7172 +sfs 2 (33) 
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and 


6s = r/is 2 - J? 2 Si + Sj s 2 . (34) 

Now we are interested in finding how the quaternion of JR are related to differential 
rotations introduced in [15]. According to [15], if the orientation difference between Frame 
{ 1 } and Frame { 2 } is small then 

1 —6 Z —6 y 

°R ss 8 Z 1 -6 X °R (35) 

. - 6y 8 X 1 J 

where 8 y , and 6 Z denote the differential rotations of Frame {1} made in any order 
about the x, y, and z axes of Frame { 0 }, respectively to bring Frame { 1 } to Frame { 2 }. 
A comparison of (31) and (35) yields 

_ '1 -6 Z -6 y 
*R S3 8 Z 1 -8 X 

. -8y 8 X 1 

from which differential rotations 8 X , 8 y , and 8 Z can be computed from the quaternion of 
JR by taking the quaternion on both sides of (36) using (26) and solving for 8 X , 8 y , and 
8 Z as follows: 

8 X sa 2 8/3 

8 V S3 2^7 . (37) 

6 Z S3 2 6( 

Equation (37) can be employed to compute the rotation velocities with a relatively 
good accuracy provided that the quaternion of jR is given. 

5 Computer Simulation Study 

This section presents the results of the computer simulation study conducted to verify the 
above mathematical developments. The study is composed mainly of three parts, the first 
part is devoted to investigate the efficiency of the derived Jacobian in converting joint 
angle velocities to Cartesian velocities, the second to evaluate the accuracy of the pseudo- 
inverse Jacobian and the third to verify the equivalence between Cartesian velocities and 
quaternion representation. Computer simulation is repeated for various sampling times so 
that a maximum permitted sampling time can be established for an acceptable conversion 
accuracy. English units will be used to present the results. 

5.1 Part 1: Joint to Cartesian Velocities 

Figure 4 illustrates the computer simulation scheme used for Part 1 and Part 2. In the up- 
per loop, a set of test joint angle trajectories are converted to the corresponding Cartesian 
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trajectories using the derived forward kinematic transformation. The orientation matrix 
°R is used to compute the differential rotations by employing (35). In the lower loop, 
the joint velocities which are obtained by differentiating the test joint angle trajectories 
are supplied to the Jacobian which produces the corresponding Cartesian velocities. The 
Cartesian velocities obtained from the upper loop are then compared with those from the 
lower loop to compute the conversion errors. Figure 5 shows the error between the x-axis 
velocities p x j (from Jacobian) and p x for two different sampling times. The maximum 
error is about 0.5 inch/sec for a sampling time of 10 msec (indicated by solid line) and 
about 6 inch/sec for a sampling time of 100 msec (indicated by asterisk line). Figure 5 
presents the error between the x-axis angular velocities lo x j and u x for sampling times of 
10 msec (solid line) and 100 msec (dotted line). The maximum angular velocity errors are 
about 0.5 miliinch/sec and 5 miliinch/sec for sampling times of 10 msec and 100 msec, 
respectively. 

5.2 Part 2: Cartesian to Joint Velocities 

In the lower loop of Figure 4, the Cartesian velocities provided by the Jacobian are 
supplied to the Jacobian pseudo-inverse which is computed by Equation (23) and whose 
outputs are compared with the joint velocities. Figures 7 and 8 show the joint angle 
velocities 9\j (from the pseudo-inverse) and 9\ for sampling times of 10 msec and 100 
msec, respectively. According to the obtained results, the pseudo- inverse does not provide 
adequate conversion of Cartesian velocities to joint velocities at a sampling time of 100 
msec. The velocity conversion is excellent at a sampling time of 10 msec. 

5.3 Part 3: Quaternion Representation 

Figure 9 illustrates the computer simulation scheme used to verify the equivalence between 
Cartesian velocities and quaternion representation. In the upper loop of Figure 9, using 
Equations (33)-(34), we compute the quaternion of the orientation difference given by 

A°R = ?R (U) ?R T (<,_!) (38) 

where °R(^) denotes the orientation matrix evaluated at the ith sampling during the 
computer simulation. In the lower loop, the quaternion can be computed from the output 
of the Jacobian by employing Equation (37) and then compared with the quaternion of 
the upper loop to determine the deviations. Figures 10 and 11 show the simulation results 
of the errors of 6/9 (solid line) and 67 (asterisk line) for sampling times of 10 msec and 
100 msec, respectively. In the case of 100 msec sampling time, the maximum errors for 
6/9 and 67 are 15 miliinch/sec and 0.15 miliinch/sec, respectively and are negligible in the 
case of the sampling time of 10ms. 
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6 Proposed Control Schemes 

This section considers the problem of controlling the compliant and non-compliant motion 
of the slave arm end-effector. When the slave arm performs non-compliant motion, i.e. 
without being in contact with the environment, it is sufficient to employ pure position 
control schemes whose error-correcting forces are computed based only on the position 
errors. However during a compliant motion mode in which the slave arm end-effector is 
constantly in contact with the environment a hybrid position/force 2 control scheme which 
controls not only the position of the end-effector but also the contact forces it applies on 
the environment, should be applied. In the following, we present and discuss three control 
schemes which have been under study for controlling the slave arm motion and briefly 
report some preliminary findings. 

6.1 Joint-Space Adaptive Control Scheme 

Figure 12 shows the organization of a joint-space control scheme which has been consid- 
ered for controlling the non-compliant motion of the slave arm. In the control scheme, 
actual joint angles measured by 7 joint sensors are compared with desired joint angles 
which are obtained from desired configuration of the slave arm end-effector through the 
inverse kinematics. The joint variable errors then serve as inputs to a set of proportional- 
derivative (PD)- controllers whose gains are adjusted by an adaptation law so that the 
error-correcting joint forces provided by the controllers track the slave arm end-effector 
along a desired path. The adaptation law was derived using the Lyapunov theory and 
the concept of model reference adaptive control (MRAC) under the assumption that the 
slave arm performs slowly varying motion. From the fact that the derived adaptation 
law does not have to evaluate the slave arm dynamics, it is computationally fast and 
very attractive to real-time control. Computer simulation results reported in [6] showed 
that the slave arm end-effector under the control of the above scheme can track several 
test paths with minimal tracking errors under sudden change in payload. The developed 
joint-space control scheme is currently implemented by GSFC for real-time control of the 
slave arm motion. 


6.2 Cartesian-Space Adaptive Control Scheme 

An adaptive control scheme in Cartesian space is presented in Figure 13. As the figure 
shows, feedback information of the actual joint variables are converted into the correspond- 
ing Cartesian variables by the forward kinematic transformation. The actual Cartesian 
variables are then compared with the desired Cartesian variables representing the desired 
configuration of the slave arm end-effector, and the corresponding Cartesian errors are 
supplied to a set of PD-controllers whose gains are adjusted by an adaptation law. The 
adaptation law is designed such that the joint forces which are obtained by transforming 

2 In this report, “position” implies both “position and orientation” and “force” both “force and torque”. 
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the Cartesian forces produced by the adaptive PD controllers using the Jacobian trans- 
pose will track the end-effector along desired paths. Extending the development in [6], an 
adaptation law was derived and presented in [5] under the assumption of slowly-varying 
motion. Computer simulation study is conducted to investigate the performance of the 
Cartesian-space control scheme and simulation results reported in [7] showed that the 
Cartesian adaptive controller can provide excellent tracking of several test paths with 
minimal tracking errors under both constant and time-varying payloads. 


6.3 Hybrid Posit ion/ Force Control Scheme 

Figure 14 presents a hybrid position/force control scheme whose structure is similar to 
that introduced in [12] except that the controller gains of the current control scheme are 
adjusted by an adaptation law. As Figure 14 shows, the control scheme mainly consists 
of two control loops, the upper loop for position and the lower for force control. A (6x6) 
diagonal compliance selection matrix S whose main diagonal elements for i = 1,2,. . . ,6 
assume either 1 or 0, allows the user to select which DOF to be position-controlled and 
which to be force- control led by setting the element s„ properly, namely sa = 1 for the ith 
DOF to be force- control led and s„ = 0 for the ith DOF to be position-controlled. In other 
words, the hybrid position/force control scheme allows independent and simultaneous 
control of position and force. The adaptation law which adjusts the gains of the PD- 
controllers of the position and force control loops so that the end-effector can follow a 
desired path while applying desired contact forces on the environment despite disturbances 
such as varying environment stiffness, was developed in [8]. Simulation results showed 
that the control scheme provided remarkable performance in simultaneous position /force 
control for both constant and variable stiffness cases. 


7 The Cartesian Adaptive Scheme 

This section is devoted to present the development of the Cartesian-space adaptive control 
scheme proposed in Section 6.2 and illustrated in Figure 13. First using the MRAC and 
Lyapunov theory, the adaptation scheme will be developed. Computer simulation will 
then be conducted to evaluate the performance of the developed adaptation scheme in 
tracking several test paths. Matrix and vector notations used in this section are listed 
below: 

• M r : transpose of the matrix M 

• 0 n : (nxn) matrix whose elements are all zero 

• I n : (nxn) identity matrix 

• fr[M]: trace of matrix M. 
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7.1 Adaptation Scheme Development 

The dynamics of a 7 DOF redundant manipulator performing non-compliant motion can 
be expressed in Cartesian space as [23] 

F(t) = 4(x,x) x(t) + #(x,x) x(t) + r(x,x) x(t) (39) 

where x(t), x(t) and x.(t) denote the (6x1) vectors of the manipulator end-effector Carte- 
sian position, velocity and acceleration, respectively and F(<), the (6x1) Cartesian force 
applied to the end-effector. 4(x, x), a (6x6) symmetric positive-definite matrix, is the 
Cartesian mass matrix, #(x, x) and F(x, x) are (6x6) matrices whose elements are highly 
complex nonlinear functions of x and x. #(x, x) x(t) and J 1 (x, x) x(t) represent the 
Cartesian Coriolis and centrifugal force vector and the Cartesian gravity loading vector, 
respectively. 

Consider now a PD controller with time-varying gains, defined by 


F(t) = K p (t)x e (t) + K d (t)x e (t) (40) 

where x e (t) given by 

x e (t) = x d (t) - x(t) (41) 

denotes the Cartesian error vector between the actual Cartesian position vector x(<) and 
the desired Cartesian position vector x d (t), K p (f) and Kj(f) are gain matrices of the 
proportional and derivative controllers, respectively. 

Substituting (40) into (39) yields 

A x e + (# + K d ) x e + (F + K p ) x e = A x d + x d + r x d (42) 


where the dependent variables of the matrices and vectors were dropped for simplicity. 

The state-space representation of (42) can be obtained by defining a (12x1) state 
variable vector z(t ) 


z(<) = [xj’(l) *.'(')] 3 


(43) 


so that (42) can be converted to 

z(t) = 

where 
and 


06 Oe 

-Bi — B2 


06 06 06 

B3 B4 Ie 


z(t) + 

B x = A-'ir + K,), B 2 = A-\$ + K d ), 


u(t) 


and 


B 3 = A- 1 r, B 4 = A- 1 
u(<)=[xj(<) xj(<) xJ(t)] T . 


(44) 

(45) 

(46) 

(47) 
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In the framework of model reference adaptive control [30], (44) represents an adjustable 
system. In order to minimize the computational burden on real-time control, a reference 
model which characterizes the desired manipulator performance, should be selected as 

Xei(t ) + 2 (i u>i x e i(t ) + u>? x ei (t) = 0 for i=l,2,. . . ,7 (48) 

where £, and denote the damping ratio and the natural frequency of x e t, and x e i(t) for 
i=l,2,. . . ,7 are the elements of the tracking error vector x e (f) defined by 

X e (t) - [Xel(f) MO • • • MOF • (49) 


As seen from Equation (48), the reference model is a linear time-invariant system consist- 
ing of 6 uncoupled systems and the ith system represents the desired behavior of error in 
the ith Cartesian position. 

From (48), the state presentation of the reference model can be obtained as 


MO = A z TO (f) = 


06 16 

-A x -A 2 


( 0 > 


(50) 


where ^i=diag(u;,?) and ^ 2 =diag( 2 £u;;) are constant (6x6) diagonal matrices, and 


M0 = [x£(f) M0] T 

(51) 

with 


x m — (^el % e 2 • • • • 

(52) 

Now solving (50), we obtain 


S 

N 

II 

N 

(53) 


where the initial value of z m (<) is denoted by z m (0). Here if we assume that the initial 
values of the actual and desired Cartesian position and velocity vectors are identical, 
i.e. z m (0) = 0, then z m (t) = 0. Otherwise we can properly select and cj, so that all 
eigenvalues of A are stable to make z m (t) — * 0 as t — too. 

Next if an adaptation error vector E(t) is defined as 

E(f) = z n (t) - z (<), (54) 


then from (44) and (50), we can obtain an error system whose dynamics is represented 

b y 


E(() 


06 16 

-A x -A 2 

06 06 

B 3 — b 4 


m + 



0 6 

-16 


u (0- 


0 6 


B 2 — A 2 


Z (0 


(55) 
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We proceed to select a Lyapunov function v(f) given by 
v(t) = E T PE + <r[(B!- 

+tr [(B 2 - A 2 ) T * 2 { B 2 - A 2 )\ + tr[ B^ 3 B 3 ] + tr[B*9 4 B 4 ), (56) 

where P and for i=l,2,» . . ,4, are positive definite matrices which will be determined. 

Differentiating (56) with respect to time and extensively simplifying the resulting 
expression yield 

v(t) = E T (P 4 1 + A t P)E + 2 tr [(Bj - ^i) T (rxJ + ^B,)] - 2 tr [bJ(TxJ - !P 3 B 3 )] 
+2 tr [(B 2 - A 2 f{Yx T e + * 2 B 2 )] - 2 tr [B[(rxJ - !P 4 B 4 )] (57) 


where 

r = [P 2 P 3 ]Z(<) = -P 2 X e - P 3 Xe (58) 


and P is given by 

p _ [ p i P 2 

[ P 2 P 3 

(59) 

and it is noted that E(f) = — z(t) since z m (t) = 0 based on our previous assumption. 

Now if and u>,- of (48) are selected so that id is a Hurwitz matrix [30], i.e. all 

eigenvalues of A have negative real parts, then according to Lyapunov Theorem , there 
exists a positive definite symmetric matrix P satisfying the Lyapunov equation given by 

PA + A t P = -Q 

(60) 

for any given positive-definite symmetric matrix Q. 
Now in (57) letting 


YxJ + ¥ a B a = Yx T e + tf 2 B 2 = 0, 

(61) 

rxj - # 3 b 3 = rxj - * 4 b 4 - o, 

(62) 

makes (57) become 

v{t) = -E t QE 

(63) 

which is a negative definite function of E(£). Also from (61)-(62), we obtain 

b, = -fj'rxj-, b 2 = 

(64) 

b, = b< = ifj'rxJ. 

(65) 


In (60), P can be made to be a positive definite matrix by properly selecting A and Q. 
Therefore, according to (56) the error system described in (55) is asymptotically stable, 
e.g. E(t) approaches zero asymptotically as t — > oo if we can show that fl*,- for i=l,2,. . . ,4, 
are also positive definite matrices. In other words, the adjustable system (44) will follow 
the reference model very closely, or z (t) approaches z m asymptotically as t — > oo. 
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Now if we assume that the end-effector motion is slow compared to the sampling rate of 
updating the values of K p (t) and Kj(t), then the manipulator dynamics can be considered 
invariant during the sampling interval of the controllers. In this case, the elements of A, 
<P and r can be considered nearly constant during the sampling interval. 

As a result, from (45) and (46) we get 

Bj ~ A~ X K V , 

( 66 ) 

B 2 ~ A~ l K d , 

(67) 

B 3 ~ 0; B 4 ~ 0. 

( 68 ) 

Substituting ( 66 )-( 68 ) into (64)-(65) yields 


A-'k r = -s>r'rx r, 

(69) 

A-'kj = -ifj'rxf, 

(70) 

and 

(71) 

Now in (69)-(70), letting 

* - ~k A ' 

(72) 

= ~& A ' 

(73) 

where 0\ and /? 2 are arbitrary positive scalars, and solving for K p and K^, 

we arrive at 

k e = ftrx f, 

(74) 

Kj = ihrxj. 

(75) 

In (72)-(73), obviously and !iP 2 are positive definite matrices that can be considered 

as nearly constant because A is positive definite and slowly time- varying. In addition, !P 3 
and ^4 should be chosen to be positive definite matrices whose determinants approach oo 
in order to satisfy (71). To achieve this, we can select #3 and 1^ 4 to be diagonal matrices 
whose main diagonal elements assume very large and positive values. 

Now integrating both sides of the equations given in (74)-(75) results in 

K p (t) = K p (0) + fix J (P 2 x e + P 3 x e )xjdt 

(76) 

and 

K d (t) = K d (0) + 0 2 j\ P 2 x e + P 3 x e )xfdf 

(77) 


where K p (0) and K<f(0) are initial conditions of K p (f) and Kj(f ), respectively and can be 
set arbitrarily. 
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The development of the adaptive controller is now completed. As shown in (76) and 
(77), the adaptation law is designed based on the errors of the Cartesian variables of 
the slave arm end-effector and the submatrices of P. Therefore, the adaptation law 
is very computationally efficient because P is a constant matrix and x e can be easily 
computed from the desired and actual Cartesian variables which are specified by the user 
and given from position sensors, respectively. The earlier assumption of slow end-effector 
motion compared to controller sampling rate is justified because high sampling rates up to 
lKHz can be utilized in the implementation of the control scheme while the manipulator 
dynamics can be considered constant during each sampling interval of typically about 1 
ms. Another attractive feature is that the implementation of the control scheme does 
not require the computation of the manipulator dynamics, which is very difficult, if not 
possible to model accurately. 

7.2 Computer Simulation Study 

This section is devoted to report results obtained from the computer simulation conducted 
to study the performance of the developed Cartesian-space adaptive control scheme which 
was applied to control the motion of a RRC K-1607 as shown in Figure 3. For the 
simulation, & and u>,- for i=l,2 are selected so that 2 characteristic roots of (11) are -1 and 
-2. Thus we have D!=2I 7 and D 2 =3I 7 . Selecting Q t = I14 for i=l,2,. . . ,7 and solving (22) 
gives P 2 = P 3 = 0.25I 7 . The adaptive controller gains are computed by substituting the 
derived values of P 2 and P 3 into (35)-(36) where K p (0) and K<*(0) can be arbitrarily set. 
The scalars fti and /? 2 can be adjusted to improve the tracking performance of the control 
scheme provided that their values are positive. In order to evaluate how the adaptive 
control scheme reacts to time- varying payload during the tracking of a desired path, the 
computer simulation is performed under sudden change in payload which is modeled by 
delayed step functions. The payload assumes zero at the beginning of the simulation, 
suddenly jumps to full payload of 10 lb at 1/3 of the simulation time and suddenly drops 
to zero again at 2/3 of the simulation time. Two study cases are considered: tracking 
a straight line and tracking a circular path during step changes in payload. A modified 
version of Manipulator Simulation Program (MSP) [32] is employed to simulate the 
dynamics of the RRC K-1607 manipulator. Fortran programs are written to implement 
the adaptive control laws to be used as a subroutine linked to the MSP program. The 
simulation is conducted on the DEC- VAX/80830 computer of GSFC with a sampling 
period of 10 msec and the simulation data are then imported into MATLAB for graphical 
presentation. 

Study Case 1: Tracking A Straight Line 

Computer simulation results of the case in which the robot end-effector is required to 
track a desired straight line in the x-y plane of the base frame from an initial position 
to a final position with desired velocity profiles, are presented in Figures 15-18. Such a 
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desired straight line path can be modeled by 


, , r 3.5 j 3.5 4 . 

x(t) = x 0 + 9[1 + 3e 3 — 4e 4 ] 

(78) 

and 

y(t ) = 2/0 H~ 9 [2 + 6e 3 1 — 8e 4 *] 

(79) 

where the initial position is specified by xo = 33.996m, t/o = 0m and the final position 
by x j — 42.996m, yj = 18m. According to Figures 15 and 16, the maximum value of 
errors in x(t) and y(f) are 0.3473in and 0.1599in, respectively. In addition, the root-mean- 
square (RMS) errors of x(£) and y(tf) are 0.1536in and 0.1047in, respectively. Position 
errors in z (t) and orientation errors are negligible according to the simulation results. As 
shown in Figure 17, the maximum velocity errors in x(t) and y(t) are -4.3450in/sec and 
-2.9749in/sec. The RMS errors of velocities in x(t) and y(t) are 0.2646 in/sec and 0.2282 
in/sec, respectively. In Figure 18 the actual path the robot end-effector tracks is shown 
versus the desired one, and despite the abrupt change in payload, the tracking quality is 
quite remarkable. 

Study Case 2: Tracking A Circular Path 


Simulation results of the case in which the manipulator end-effector is 
a desired circular path in the x-y plane of the base frame are reported 
The circular path consisting of 3 segments is modeled by 

required to track 
in Figures 19-22. 

x(t ) = Rcos^i] y(i ) — Rs'm$i for t,_i < t < <, 

(80) 

for i= 1 ,2,3 where the circular path radius R = 24.32m, and 


* 1(0 = 4>o + ^ 2 ) 

(81) 

^2(0 = <f>l + u(t - <x), 

(82) 

$3^) = <f>0 ~ ^(<3 — t ) 2 

(83) 


with <f > o = Om; <j>\ = angular velocity u> — ^ radian/ sec and the angular accelera- 

tion /? = ^-radian j sec 2 . Figure 19 and 20 show that the maximum value of errors in x(t) 
and y(t) are 0.6551in and 0.6764in, respectively. Furthermore, the RMS errors of x(t) 
and y(/) are 0.2730in and 0.3657in, respectively. According to the computer simulation 
results, position errors in z (t) and orientation errors are negligible. As shown in Figure 
21, the maximum velocity errors in x(f) and y(t) are -5.8144in/sec and 6.1431in/sec. It 
also shows that the RMS errors of velocities in x(t) and y (t) are 0.8217 in/sec and 0.7790 
in/sec, respectively. According to Figure 22 which presents the actual and desired circular 
paths, the tracking quality is extraordinary in spite of the step changes in payload. 
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8 Conclusion 


In this report, we have considered the kinematic analysis and control of a 7 DOF kine- 
matically redundant manipulator which is the slave arm of a dual-arm telerobot testbed 
developed at GSFC to investigate the feasibility of telerobotic applications in space. The 
forward kinematic transformation for the slave arm was derived and simplified for real- 
time implementation. Employing the method of vector cross product, we obtained the 
slave arm Jacobian matrix and computed its inverse using the Moore-Penrose pseudo- 
inverse method. The concept of quaternion was reviewed for representing the orientation 
of the slave arm end-effector and the relationship between quaternion and differential 
rotations was established. Computer simulation was performed to verify the efficiency of 
the Jacobian in converting joint velocities to Cartesian velocities and to investigate the 
accuracy of the Jacobian pseudo-inverse. The equivalence between differential rotations 
and quaternion was also verified through computer simulation. Simulation results showed 
that the maximum sampling time which ensures the efficiency of the Jacobian, its pseudo- 
inverse, and the quaternion representation was about 10 msec. Three control schemes was 
proposed for controlling the compliant and non-compliant motion of the slave arm and 
simulation study results were presented and discussed. The development of the Cartesian 
adaptive control scheme was presented and computer simulation was performed to evalu- 
ate the tracking performance of the developed control scheme. Current research activities 
are focusing on the implementation of the developed mathematical results and proposed 
control schemes for real-time control applications. 
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Figure 1: The GSFC Telerobot Testbed 
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Figure 2: Block diagram of the GSFC Telerobot Testbed 
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Figure 3: Coordiate frame assignment for the RRC K-1607 slave arm 



Figure 4: Computer simulation scheme for Part 1 and Part 2 
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Figure 5: Errors of x-axis velocities 
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Figure 7: Velocities of joint angle 1 for sampling time of 10msec 
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Figure 8: Velocities of joint angle 1 for sampling time of 100msec 
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Figure 11: Quaternion errors for sampling time of 100 msec 
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Figure 12: The joint-space adaptive control scheme 







Figure 13: The Cartesian-space adaptive control scheme 
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Figure 14: The hybrid adaptive control scheme 
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Figure 17: Velocity errors in tracking a straight line 
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